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INTRODUCTION 


The  successful  development  of  an  autonomous  vision  system  for  mobile 
robot  vehicles  would  be  of  considerable  value  and  Importance  to  defense  and 
related  fields.  Numerous  reports  and  studies  currently  recommend  artificial 
Intelllgence/robotlcs  applications  which  require  autonomous  vehicles. 

Essential  to  these  robotic  vehicles  Is  an  adequate  and  efficient  computer 
vision  system.  A  potentially  more  successful  approach,  other  than  TV  pictures 
and  photographs,  would  be  to  develop  a  3-0  system  employing  a  laser  range¬ 
finder.  The  author  has  been  conducting  studies  for  many  years  on  application 
of  a  laser  rangefinder  vision  system  for  a  Hars  autonomous  rover  vehicle.  It 
seems  feasible  to  transfer  part  of  the  technology  and  experiences  obtained 
from  the  past  Mars  project  to  the  present  task  on  autonomous  navigation  for 
mobile  robot  vehicle  over  hilly  terrains. 

The  scanning  scheme  takes  into  consideration  the  following:  To  detect 
the  edges  of  an  obstacle,  the  horizontal  data  spacing  should  be  sufficiently 
small.  From  the  viewpoint  of  estimation  of  the  terrain  slope,  the  possible 
spurious  errors  due  to  differentiation  of  the  range  data  should  be  filtered. 
Outlines  of  obstacles  on  terrain  surfaces  are  determined  as  discrete  Inputs  to 
the  system  and  the  Rapid  Estimation  Scheme  Is  utilized  to  detect  the  outlines 
of  the  obstacles.  Smoothed  estimates  of  range  slopes  are  obtained  by  fitting 
a  two-dimensional  approximating  function  stochastically  to  a  finite  set  of 
noise  corrupted  data  from  measuring  the  rough  terrain.  The  in-path  and 
cross-path  terrain  slopes  and  their  variances  at  the  data  points  are  estimated 
from  the  set  of  corresponding  range  slopes.  The  path  selection  scheme  Is  a 
decision-making  process:  A  modified  vector  space  algorithm  Is  developed  to 


evaluate  the  corridor  costs  for  a  tvo-level  radial  corridor  structure. 
Starting  with  the  In-path  slopes,  cross-path  slopes,  obstruction  height,  and 
wheel  deviation  at  the  spine  and  track  points,  the  algorithm  Is  applied 
repeatedly  to  give  a  cost  Index  to  each  corridor.  An  optimal  path  which 
minimizes  the  cost  Index  Is  then  determined  using  dynamic  programming  on  the 
corridor  structure. 

THE  NAVIGATION  SYSTEM 

A  range  matrix  describing  a  certain  scanned  area  of  the  terrain  In  front 
of  the  mobile  robot,  as  shown  In  Figure  1,  can  be  used  to  detect  edges  of 
discrete  objects  or  to  estimate  the  slopes  of  the  terrain.  With  reference  to 
the  diagram  In  Figure  2,  the  Rapid  Estimation  Scheme  was  developed  to  process 
the  range  matrix  and  to  detect  the  possible  edges  of  obstacles.  These 
detected  points  are  fed  Into  an  obstacle  Identification  scheme  In  which  a 
whole  set  of  detected  points  are  classified  Into  subsets.  Each  subset  Is 
recognized  either  as  a  boulder,  a  crater,  or  a  hill.  Then  the  locations  and 
the  sizes  of  the  obstacles  are  used  to  determine  the  lengths  of  the  passible 
corridors  for  the  mobile  robot  vehicle.  In  parallel  with  the  above 
procedures,  the  In-path  and  cross-path  slopes  of  the  terrain  are  estimated  by 
a  slope  estimation  scheme.  These  slope  informations  along  the  passible 
corridors  are  utilized  to  determine  a  safer  and  more  accurate  path  for  the 
mobile  robot  vehicle  to  travel. 

The  mobile  robot  vehicle  is  equipped  with  data  acquisition  and  decision 
making  devices  for  Its  autonomous  navigation  over  rough  terrain.  A  laser 
rangefinder  Is  chosen  as  a  principal  sensing  device,  which  can  determine  the 


radial  distances  to  the  unpredictable  hilly  terrain  surfaces.  A  rangefinder 
can  be  operated  by  emitting  laser  pulses  and  measuring  the  time  of  flight  of  a 
pulse  between  the  Instant  It  was  transmitted  and  the  Instant  the  reflected 
pulse  Is  received.  This  time  of  flight  is  related  to  the  distance  between  the 
transmitter  and  the  point  on  the  terrain  from  which  the  pulse  Is  reflected. 
With  reference  to  Figure  1,  the  terrain  Is  scanned  by  changing  the  azimuth 
(Oj).  and  elevation  (3^)  angles  of  the  laser  beam  In  a  discrete  fashion.  The 
measurements  are  then  available  In  the  form  of  a  NXM  'range-matrix*  as 
follows: 

M  *  [mj^j],  1>1,...N;  j=l , . . .M  (1) 

where  each  entry  Is  modeled  as: 

where  Is  the  true  range  corresponding  to  the  position  angle  3 j) ,  and 

v^^j  Is  a  zero  mean  Gaussian  noise  sequence. 

SCANNING  SCHEME 

The  scanning  scheme  (ref  1)  makes  the  compromise  of  two  conflicting 
factors  between  that  of  not  missing  any  sizeable  obstacles,  and  that  of 
accurately  determining  the  gradient  of  the  terrain.  With  reference  to  Figure 
1,  a  rangefinder  Is  located  about  2  m  above  the  ground.  For  navigation 
purposes.  It  is  desired  to  cover  a  horizontal  terrain  from  5  m  to  30  m  in 
radial  directions.  The  resolution  of  a  rangefinder  Is  limited  by  noise 

^C.  N.  Shen  and  C.  S.  Kim,  "A  Laser  Rangefinder  Path  Selection  System  for 
Martian  Rover  Using  Logarithmic  Scanning  Scheme,”  VIII  IFAC  Symposium  on 
Automatic  Control  In  Space,  Oxford,  U.K.,  July  1979. 


eleaents  In  positioning  angles  as  well  as  the  range  error.  It  Is  assumed  that 
the  standard  deviation  of  the  positioning  angles  and  the  measured  ranges  are 
og  «  1  arc  minute  and  ■  0.05  m,  respectively. 

(I)  The  Incremental  pointing  angle  A3  should  be  greater  than  Its  standard 

deviation,  i.e.,  A0  >  ■  /2  arc  minute. 

(II)  From  the  viewpoint  of  the  obstacle  detection  scheme,  the  scheme 
needs  at  least  three  data  points  on  the  face  of  the  obstacles.  Thus,  to 
detect  the  edges  of  an  obstacle  whose  dimension  Is  greater  than  2  m  In  size, 
the  horizontal  data  spacing  Ap  should  be  less  than  (2/3)m. 

(III)  From  the  viewpoint  of  the  slope  estimation  of  the  terrain.  It  Is 
necessary  to  consider  the  possible  spurious  errors  In  the  slope  estimation  due 
to  range  errors  where  Og^  ^  O.OS  m. 

Figure  3  Indicates  a  possible  spurious  error  in  the  estimated  slope  for  a 
flat  terrain.  If  mi,j  “  ^i,j  “  ®l+l,j  “  ^1+1,  j  ®m»  the  resultant 

erroneous  slope  would  be  (Oy/Ox)  Instead  of  zero.  Thus,  we  call  (Oy/Ox)  as  a 
slope  error  Index.  In  the  previous  research  It  was  reported  that  this  Index 
Is  a  function  of  the  elevation  angle  3^^^: 

Y(3i,A3)  -  Oy/Ox  -  20n  sin  B{ht(  AB/sln^B)  -  20^,  cos  (3) 

where 

6  -  (3i  +  3i+i)/2  (3a) 

A3  -  Sj+i  -  3i  (3b) 

With  reference  to  the  design  criteria  (11)  and  (111)  above,  one  would  like  to 
have  a  scanning  scheme  which  satisfies  the  constraints;  Ap  <  (2/3)m,  and 
y  <  0.25.  It  Is  noted  that  these  are  two  conflicting  factors.  It  Is 
concluded  that  the  use  of  a  constant  A3  for  the  whole  region  Is  prohibitive. 
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Therefore,  It  is  proposed  to  divide  the  whole  area  into  three  sub-areas,  and 
use  different  3  for  each.  Table  I  shows  a  set  of  A3's  for  three  sub-areas. 
Area  1  is  close  by,  while  area  3  is  far  away. 

TABLE  I.  SCANNING  SCHEME  (ALL  ANGLES  IN  RADIANS) 


^max 

^mln 

A3 

A0 

Area  1 

0.5039 

0.1937 

0.0282 

mm 

Area  2 

0.3115 

0.117 

0.0083 

Area  3 

0.15058 

0.03590 

0.00217 

0.03 

For  this  scanning  scheme,  the  resultant  horizontal  data  spacing  Ap  and  the 
slope  error  induces  Y  are  shown  In  Figure  4.  Here,  it  is  noted  that  the 
proposed  scanning  scheme  satisfies  the  constraints  Y  <  0.25  and  Ap  <  (2/3)m 
except  that  Ap  >  (2/3)m  for  P  >  25  m.  However,  this  is  justifiable  in  that, 
at  far  distances,  tie  do  not  require  as  good  a  resolution  as  the  one  at  near 
distances. 


OBSTACLE  DETECTION 

Detection  of  Discrete  Obstacles 

Rapid  Estimation  Scheme  (refs  2,3)  has  been  developed  to  estimate  and 
detect  the  discrete  inputs  with  unknown  magnitude  which  occur  at  unknown 
instances  of  time.  Outlines  of  obstacles  are  considered  as  discrete  changes 


^R.  V.  Sonalker  and  C.  N.  Shen,  "Mars  Obstacle  Detection  by  Rapid  Estimation 
Scheme  From  Noisy  Laser  Rangefinder  Readings,"  Proceedings  of  the  Milwaukee 
Symposium  on  Automatic  Computation  and  Control,  Wisconsin,  April  1975,  pp. 
291-296. 

^C.  S.  Kim,  R.  C.  Marynowski,  and  C.  N.  Shen,  "Obstacle  Detection  Using 
Stabilized  Rapid  Estimation  Scheme  With  Modified  Decision  Tree,"  Proceedings 
of  JACC,  Philadelphia,  PA,  October  1978. 
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In  the  slopes  of  the  terrain.  These  discrete  Jumps  are  modeled  as  discrete 
Inputs  to  the  system  and  the  R.E.S.  Is  utilized  to  detect  the  outlines  of  the 
obstacles. 


With  reference  to  Figure  3,  1^  Is  the  distance  from  the  rangefinder  to  a 
point  In  the  terrain  and  gj^  Is  the  Incremental  change  In  the  adjacent  ranges 
tflth  constant  azimuth  angle.  As  Is  noticed,  there  occur  sudden  changes  In 
g^'s  both  at  the  top  and  at  the  bottom  of  the  boulder.  This  sudden  change  In 
gj^'s  Is  modeled  as  a  discrete  Input  U)^  to  the  system  as  follows: 


—  ^ 

—  — 

— 

— 

^1+1 

Uj  1-p 

h 

0)^1 

0 

■ 

+ 

0 

+ 

81+1 

0  C'i 

81 

1 

where  Ulfl  and  are  plant  noises  and 

-  (1-A6^‘tan  3i)/(l+2 ABfcos  Sj)  (5; 

and 


and 


U  Is  a  stabilizing  factor  0  <  u  <  1 


^>i » i-u(i-ci)  (6: 

where 

5i  =■  (l+A^i  •  tan  0i)-^  (7; 

The  corresponding  measurement  equation  Is: 

■“l+l  *  ^1+1  vi+i  (s; 

where  Is  the  measurement  noise.  At  stage  1,  R.E.S.  utilizes  Kalman 

filter  and  Input  estimation  scheme  to  estimate  the  states  gi-t-il.  [H+2i 

81+2 1 »  t^l+3»  81+31 »  and  [I1+4,  gi+4]  under  three  different  hypotheses: 


Hi ;  an  input  exists  between  stages  1  and  1-4-1 . 

H2:  an  Input  exists  between  stages  1+1  and  1+2. 

Hq;  no  Input  exists  b«»tween  stages  1  and  1+2. 

The  joint  conditional  probability  for  each  hypothesis  Is  computed  from  the 

conditional  state  estimates  and  the  measurement  data.  By  using  joint 
conditional  probability,  the  hypothesis  with  minimum  Bayes  risk  Is  accepted  as 
a  true  hypothesis.  Acceptance  of  as  true  hypothesis  corresponds  to  a 
detection  of  an  edge.  If  H2  or  Hq  la  accepted,  the  scheme  proceeds  to  the 
next  stage.  R.E.S.  processes  the  range  matrix,  column-wise,  to  detect  the 
vertical  edges  of  the  obstacles.  It  should  be  noted  that  single  detection 
occurs  at  the  bottom  of  the  boulder  or  at  the  far  edge  of  the  crater.  On  the 
other  hand,  two  consecutive  detections  occur  at  the  top  of  the  boulder  or  at 
the  near  edge  of  the  crater.  Side  edges  of  the  obstacles  are  detected  by 
processing  the  range  matrix  row-wise. 

Edge  Detection  Results 

The  simulation  of  terrain  with  hills  and  valleys  is  given  in  Figure  5. 
Figure  6  shows  the  edges  of  boulders,  craters,  and  ridges  detected  by  the 
rapid  estimation  scheme.  The  *'s  and  O's  indicate  the  edges  detected  by 
processing  the  range  matrix  column-wise  and  row-wise,  respectively.  The  rapid 
estimation  scheme  also  produces  some  false  detections.  Therefore,  these 
detected  edges  are  processed  by  a  heuristic  algorithm  which  classifies  all  the 
detected  points  as  belonging  to  a  boulder,  crater,  ridge,  or  false  detections. 
Figure  7  shows  the  result  of  this  obstacle  Identification  scheme.  Here,  the 
characters  'B',  'C,  and  'R'  represent  the  edges  of  boulders,  craters,  and 
ridges,  respectively.  The  three  ridges  shown  at  the  top  of  Figure  7  are  the 
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tops  of  the  hills  of  which  the  centers  are  at  (x,y)  (0,40),  (-20,60),  and 

(20,60)  in  Figure  5. 


SLOPE  ESTIMATION 
Range  Slopes  Estimation 

The  slope  estimation  problem  (refs  4,5)  dealt  with  in  this  section  is 
that  of  obtaining  smoothed  estimates  of  function  values  and  particularly  their 
derivatives  from  a  finite  set  of  inaccurate  measurements  in  two-dimensions. 

In  one  approach  we  can  Identify  the  dynamic  equations  of  the  underlying 
system,  or  estimate  the  distributions  for  the  quantities  of  Interest  and  then 
apply  optimal  estimation  algorithms.  In  some  engineering  problems  the 
stochastic  system  may  not  be  identified  easily  and  in  these  situations,  spline 
smoothing  has  proved  to  be  a  useful  alternative. 

In  this  report,  we  obtain  the  smoothed  estimates  of  the  slopes  by 
utilizing  a  two-dimensional  smoothing  algorithm.  For  the  problem  of  smoothing 
a  finite  set  of  noise  corrupted  data  of  an  unknown  function  f(^, n),  it  is 
proposed  to  obtain  the  smoothed  estimate  of  f(C,Ti)  by  fitting  a  two- 
dimensional  approximating  function  s(C,n)  to  the  data  set.  For  a  set  of 
measurements  corrupted  by  a  white  noise  process 

i  -  1,2 . N 

™l,j  *  f(^l.ni)  +  Vi  j,  (9) 

J  =  1,2 . M 


^C.  S.  Kim  and  C.  N.  Shen,  "Design  of  a  Recursive  Vector  Processor  Using 
Polynomial  Splines,**  Proceedings  of  the  19th  IEEE  Conference  on  Decision  and 
Control,  Albuquerque,  NM,  December  1980. 

^C.  S.  Kim  and  C.  N.  Shen,  *'A  Recursive  Algorithm  for  Smoothing  by  Spline 
Functions,**  Proceedings  of  the  International  Congress  on  Applied  Systems 
Research  and  Cybernetics,  Acapulco,  Mexico,  December  1980. 


an  unknown  function  f(C,n)  Is  defined  In  the  region  {(^,h)|Ci  <  i  < 
hi  <  n  <  Is  approximated  by  s(^,n)  which  minimizes  the  following 
objective  function: 


M  N 

J  ■  I  I  [8(^1. hj)  “®1,  jl^R"^l,  j  IsC^l.'lj)  -  ®l,j] 

J-1  1-1 

M-1  N-1  "j+l  ,^l+l 

+  P  I  ).  /  /  z(C,n)dWn  ( 

j-1  1-1  Hj  Cl 

where  p  >  0  Is  the  smoothing  parameter,  Ri,j  la  Che  observation  error 

A 

variance,  Ri,j  “  ^^'^l.j  *  '^Itj^^*  z(5»h)  Is  some  smoothness  measure  of 

a(C,n)  at  (C,n). 

Terrain  Slopes  and  Range  Slopes 


With  reference  to  Figure  1,  terrain  In-path  and  cross-path  slopes  are 
defined  as  the  two  orthogonal  slopes  dz/dp  and  dz/pdB  in  a  cylindrical 
coordinate  system.  During  the  past  Investigations,  the  terrain  slopes  were 


found  to  be  appropriate  measures  for  evaluating  a  terrain.  A  direct  approach 
for  estimating  the  terrain  slopes  would  be  to  fit  a  smoothing  spline  to  the 


measurement  data  In  cylindrical  coordinates.  However,  there  Is  a  major 
difficulty  In  this  approach:  Even  Chough  the  two  Independent  variables 
and  0j  for  the  rangefinder  are  changing  with  constant  Increments  Ag  and  A9, 
respectively,  the  Independent  variable  pj^  In  a  cylindrical  coordinate  changes 
irregularly. 


The  recursive  smoothing  algorithm  In  the  previous  subsection  requires 
that  the  data  points  be  located  at  the  corners  of  rectangular  grids  of  the  two 
Independent  variables.  Since  the  two  Independent  variables  Pj^  and  6j  In  a 
cylindrical  coordinate  system  do  not  form  rectangular  grids,  the  smoothing 


,N 


algorithm  cannot  be  applied  directly*  By  noting  that  the  positioning  angles 
and  8j  are  changing  In  regular  fashion.  It  Is  proposed  to  obtain  the 
smoothed  estimates  of  the  range  slopes  dr/d 3  and  dr/d 6  defined  In  spherical 
coordinates.  Then,  these  estimates  are  transformed  to  the  terrain  slopes. 

In  applying  the  smoothing  algorithm  to  terrain  slope  estimation  one  point 
to  be  mentioned  Is  that  the  basic  philosophy  of  the  smoothing  spline  approach 
Is  to  suppress  the  noise  elements  by  fitting  a  smooth  approximating  function 
to  a  noise  corrupted  data  set.  Thus,  when  the  function  to  be  approximated  has 
sharp  changes  In  Its  values  or  derivatives,  the  smooching  algorithm  will 
produce  errors  In  the  results  by  smoothing  out  these  actual  sharp  changes. 

From  Che  viewpoint  of  terrain  slope  estimation,  such  changes  occur  at  Che 
edges  of  a  boulder,  a  crater,  or  a  ridge  on  the  terrain.  Thus,  It  Is  proposed 
to  detect  these  edges  by  using  the  rapid  estimation  scheme.  Then,  for  the 
area  which  Is  free  of  discrete  edges,  the  two-dimensional  smoothing  algorithm 


Is  utilized  to  estimate  the  slopes.  The  terrain  slopes  are  estimated  In  the 
order  (1)  discrete  edges  are  detected  by  using  Che  rapid  estimation  scheme; 
(11)  for  the  area  which  Is  free  of  discrete  edges,  a  two-dimensional  smooching 
algorithm  is  utilized  to  estimate  Che  range  slopes;  (111)  estimated  range 
slopes  are  transformed  Into  terrain  slopes. 

Estimated  Terrain  In-Path  Slope 


The  estimated  terrain  In-path  slopes  (ref  6)  are  displayed  in  terms  of  a 
slope  map.  Figure  8.  Characters  A, ...G  represent  a  particular  range  of  the 


^C.  S.  Kim  and  C.  N.  Shen,  "Estimating  Planetary  Terrain  Slopes  From  Range 
Measurements  Using  a  Two-Dimensional  Spline  Smoothing  Technique,"  Proceedings 
of  the  8th  Trlannual  World  Congress,  International  Federation  of  Automatic 
Control,  August  1981,  Kyoto,  Japan. 
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terrain  In-path  slopes  Increasing  from  A  to  G,  at  the  corresponding  location. 

U  represents  undefined  slopes.  In  Figure  8,  we  note  circular  slope  regions  on 
the  faces  of  sinusoidal  hills  and  valleys.  Also,  along  a  radial  direction, 
the  estinated  slopes  are  changing  slowly  from  one  region  of  slopes  to  another. 
The  large  empty  spaces  are  due  to  the  hidden  regions  at  the  back  of  boulders 
or  hills  where  laser  rays  could  not  reach.  The  undefined  gradient  represented 
by  'U*  occurs  when  the  recursive  algorithm  cannot  be  applied  due  to  sharp 
changes  In  ranges  between  adjacent  measurement  data.  The  estimated  In-path 
terrain  slope  maps  are  used  for  the  evaluation  of  the  terrain  In  front  of  the 
mobile  robot  vehicle. 

Terrain  Cross-Path  Slopes 

In  discussing  the  terrain  croas*-path  slopes  (ref  7),  the  data  can  be 
conveniently  processed  to  generate  smoothed  In-path  and  cross-path  range 
slopes  recursively  In  spherical  coordinate  system  due  to  the  regularity  of  the 
elevation  and  azimuth  angles.  When  we  proceed  to  calculate  the  true  terrain 
slopes  on  the  base  plane,  the  regularity  of  the  data  points  are  completely 
destroyed.  For  a  fixed  elevation  angle  B,  the  horizontal  projection  of  the 
range  data  are  not  located  at  a  fixed  distance  from  the  rover.  It  is  desired 
to  calculate  the  cross-path  slope  at  point  (B£,6j).  However,  In  general, 

Pl,j  *  Pi,j4-l<  Thus,  the  true  cross-path  slope  Is  not  along  an  arc  connecting 
points  Pi,j  and  Pi^^l* 

Our  algorithm  to  calculate  the  terrain  cross-path  slope  can  then  be 
summarized  as  follows: 

^C.  N.  Shen  and  Poueau  Shen,  "The  Estimation  of  Terrain  Cross-Path  Slopes," 
Proceedings  of  the  11th  Annual  Pittsburgh  International  Conference  on 
Modeling  and  Simulation,  University  of  Pittsburgh,  May  1980. 


1.  Obtain  the  range  neasurenients. 

2.  Use  the  smoothing  algorithm  to  calculate  the  range  cross-path  slope. 

3*  Obtain  the  terrain  cross-path  slope  and  Its  variance. 

PATH  SELECTION 

The  path  selection  scheme  (ref  8)  Is  a  declslon-maklng  process  with  the 
goal  In  determining  an  optimal  path  for  the  mobile  robot  vehicle  to  navigate. 
The  first  part  of  this  scheme  consists  of  data-acqulsltlon,  obstacle 
detection,  gradient  estimation,  and  Interpolation  algorithms.  From  these 
algorithms,  the  In-path  and  cross-path  slopes  and  their  covariances  at  the 
spine  and  track  points  are  obtained.  Using  this  Information,  a  series  of 
variables  describing  the  features  of  the  terrain  will  be  calculated. 

Based  on  the  terrain  variables,  we  quantify  the  corridor  variables, 
risks,  and  costs  for  the  corridors  on  which  the  optimal  path  selection 
algorithm  Is  applied. 

1.  The  Input  data  comprises  only  the  In-path  and  cross-path  slopes  and 
their  variances. 

2.  The  terrain  variables  are  corrupted  by  noise.  To  consider  the 
uncertainty  In  the  measurements,  N  standard  deviations  are  added  to  each 
terrain  variable.  Then  the  terrain  variables  are  normalized  with  respect  to 
their  threshold  values  respectively. 

3.  The  modified  vector  space  algorithm  Is  developed  and  applied 
repeatedly  In  the  evaluation  of  the  corridor  variables  later  on,  also  In 

^Poueau  Shen  and  C.  N.  Shen,  "Modified  Vector  Space  Algorithm  Applied  to  Path 
Selection  Scheme,"  Proceedings  of  the  llth  Annual  Pittsburgh  International 
Conference  on  Modeling  and  Simulation,  University  of  Pittsburgh,  May  1980. 
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evaluation  of  risks  and  costs. 

Evaluation  of  Terrain  Variables 

As  aentloned  In  the  Introduction,  In  the  evaluation  of  terrain  variables, 
we  only  use  the  slopes  at  the  spine  and  track  points.  The  reason  Is  two-fold. 
First,  only  a  minor  part  of  this  path  selection  scheme  need  the  data  of 
elevation,  which  can  be  generated  by  the  slopes.  Second,  If  we  adopt  the 
elevation  estimates  as  our  Input  data,  we  will  get  larger  errors  In  the 
calculation  of  In-path  and  tilt  slope  terrain  variables. 

The  expressions  of  the  terrain  variables  and  the  variances  together  with 
the  corresponding  explanations  are  listed  below: 

I(k)  -  (8(1,1)  +  s(3,l)  +  s(l,3)  +  s(3, 3)1/4 
Oi2(k)  -  (Og^d,!)  +  +  Og 2(1,3)  +  Og 2(3, 3)1/16  (11) 

X(k)  -  lc(l,l)  +  c(3,l)  +  c(l,3)  +  c(3, 3)1/4 

«c^<3,l)  +  0^2(1, 3)  +  0^2(3^3)3/16  (12) 

B(k)  -  MAX  (Bi,  B2,  B3,  B4,  B5,  Be)  , 

b 

typical  B's,  e.g.  B4  -  -  [c(3,l)  -  c(l,l)l 

O 

032(1^)  ■  o2(k  -  Index(MAX(B)))  (13) 

W(k)  -  -  |a(rai-m2)  +  b(ni-n2)|  * 

1  1 
«1  (9(1.3)  +  8(1, 1)1  ,  m2  --  (8(3,3)  +  s(3, 1)1  , 

-1  -1 

ni  -  --  (c(l,l)  +  c(3,l)l  ,  n2  -  --  [c(l,3)  +  c(3,3))l 

2  2 


Ow2(k)  -  Var(W(k)) 


(14) 


( 

( 


where  8(1 tw)  and  c(il,m)  are  In-path  and  cross-path  terrain  slopes, 
respectively. 

In-Path  Terrain  Variables.  The  In-path  slope  terrain  variable  I(k)  gives 
the  average  of  the  in— path  slopes  for  the  four  vehicle  wheels  at  each  section. 
This  variable  is  a  measure  of  the  risk  in  the  forward  direction.  The  in-path 
slope  terrain  variable  I(k)  and  its  variance  are  expressed  by  Eq.  (11). 

Tilt  Slope.  Tilt  slope  terrain  variable  X(k)  is  used  to  estimate 
excessive  cross-path  slopes  which  may  cause  the  vehicle  to  tip  over.  The  tilt 
slope  terrain  variable  and  its  variance  are  given  by  Eq.  (12). 

Obstruction  Height.  The  obstruction  height  is  calculated  for  six 
different  locations  at  each  discrete  section  of  the  terrain.  The  maximum 
value  la  then  chosen  as  representative  of  this  whole  section. 

In  deriving  the  formula  for  a  typical  obstruction  height,  we  use  a  third 
order  polynomial  to  approximate  the  terrain  elevation  in  each  location.  By 
differentiating  this  polynomial  with  respect  to  the  distance,  we  get  an 
expression  for  the  slope.  With  the  known  data  of  slopes  at  the  three  points 
substituted  into  this  expression,  we  can  determine  the  coefficients  of  the 
polynomial.  Using  this  polynomial,  we  can  then  find  the  obstruction  height  in 
this  direction.  The  formula  for  obstruction  height  is  given  in  Eq.  (13). 

Wheel  Deviation.  The  wheel  deviation  variable  W(k)  describes  the  offset 
of  any  of  the  four  wheels  from  a  plane.  Wheels  on  any  three  track  points 
define  a  plane.  For  each  combination  of  three  wheels  touching  the  terrain, 
the  deviation  of  the  fourth  wheel  with  respect  to  this  plane  is  defined  as  the 
wheel  deviation.  The  formula  is  as  shown  in  Eq.  (14). 


MonMlisatlon  of  Terrain  Variablas 


Tha  four  terrain  variables  represent  different  charscterlstlcs  of  the 
terrain.  They  are  noraallsed  so  that  couparlsons  can  be  drawn  from  a  common 

basis. 

The  nonullsatlon  process  of  the  terrain  variables  consists  of  two  steps 
First,  N  standard  deviations  are  added  to  each  variable  to  Increase  the 
reliability.  Second,  each  variable  Is  divided  by  Its  own  threshold  value, 
bacoalng  non-dluenslonal  and  comparable.  The  formula  and  basic  features  of 
the  normalization  process  are  shown  below. 

lN<k)  -  [I(k)  +  Noi(k)]/Ti 
B^Ck)  -  (B(k)  +  NOB(lt)l/TB 
X„(k)  -  [X(k)  +  NOx{k)l/Tx 

-  IW(k)  +  No„(k)]/Tw  (15 

where  the  threshold  values  are 

Ti  -  0.51  -  tan  27*  Tb  -  0.34  m 

Tx  -  0.58  -  can  30*  -  0.8  (16 

a.  Concerning  the  stochastic  aspect  of  the  data,  we  assume  that  the 
variables  are  Gaussian  with  standard  deviation  o.  As  Is  noticed  In  Eq.  (15), 
not  only  the  mean  value,  but  also  the  standard  deviation  of  Che 

estimated  value  Is  used  for  the  computation  of  normalized  terrain  variables. 
The  probability  for  the  real  quantity  being  less  than  the  normalized  terrain 
variable  Is  0.683  for  N  >  1  and  0.955  for  N  2,  etc. 

b.  The  second  feature  of  the  normalization  Is  with  respect  to  each 
threshold  value.  These  threshold  values  represent  the  upper  limit  for  the 
terrain  variables  In  a  sense  that  once  they  are  exceeded,  there  will  be 


disaster  or  obstruction  to  the  vehicle*  By  dividing  each  terrain  variable  by 
Its  threshold  value,  the  terrain  variables  become  non-dimensional  and 
comparable. 

Modified  Vector  Space  Algorithm 

Corridor  variables  are  defined  as  the  representative  quantities  for  the 
terrain  variables  along  a  given  corridor.  They  are  evaluated  by  utilizing  the 
terrain  variables  for  discrete  sections  of  each  corridor  as  Input.  To 
emphasize  the  contribution  of  hlgh-values  of  the  terrain  variables  to  a 
corridor,  the  Modified  Vector  Space  Algorithm  has  been  Implemented.  The 
formulas  for  the  corridor  variables  U^.  are  as  follows: 

M 

Uc  “  (  I  UNP(lt)/M)l/P  (17) 

k-1 


where  UuCk)  Is  the  specific  series  of  normalized  terrain  variable  In  concern. 
Equation  (17)  Is  basically  a  generalization  of  the  norm  of  a  vector  space. 

M 

U  -  Norm  -  (  I  UN^(k))l/P  (18) 

k-1 

It  should  be  noted  that  the  modified  norm  Is  different  from  the  usual 
norm  In  that  It  Is  divided  by  the  number  of  elements  M.  The  reason  for  this 
division  Is  that  our  corridors  may  be  of  varied  lengths  (which  means  varied 
number  of  discrete  sections).  By  doing  this,  corridors  of  different  lengths 
can  be  compared. 

There  Is  an  analogy  between  this  algorithm  and  the  logic  gate  for  the 
case  of  p  -  1  and  p  -  The  case  of  p  »  I  corresponds  to  a  multi-input  AND 
gate,  while  p  -  corresponds  to  an  OR  gate. 


— r  _  V" 


In  general,  for  the  four  terrain  variables,  we  have  the  following 
formulas 

ic  -  (  I 

k-1 

M 

Be  “  (  I  BHP(k)/M)l/B 

k»l 

M 

Xc  -  (  I  XNP(k)/M)l/B 

k=»l 

M 

Wc  -  (  I  WNP(k)/M)l/P  (19) 

k-1 

The  risk  index  R,  represents  the  overall  effect  of  the  four  terrain  variables. 
Risk  Index 

Risk  is  defined  as  the  overall  contribution  of  the  four  corridor 
variables  by  the  use  of  aiodified  vector  space  algorithm. 

R  -  (dc**  +  Xc**  +  Be*"  +  Wc^)/4jl/P  (20) 


Radial  Corridor  Structure 

In  simulating  the  possible  routes  which  the  vehicle  might  take,  a  radial 
corridor  structure  is  adopted.  The  structure  consists  of  two  levels,  primary 
corridors  and  secondary  corridors.  The  primary  corridors  represent  the 
possible  choice  of  paths,  while  the  secondary  corridors  provide  a  preview  of 
the  farther  terrain. 

Short  Length  Penalty  and  Target  Deviation  Penalty 

Short  length  penalty  S  and  target  deviation  0  are  defined  for  each 
corridor  as 

ip  COS 

S -  (21) 

i  cos  9 
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^ 


1-1  Lt 


where  «  5  m;  min  corridor  length 

Lt  -  25  m:  threshold  value  of  target  deviation 


0T  -  45" 


threshold  value  of  azimuth  angle 


Subscript  n  refers  to  the  n^^  stage 


Corridor  Cost  and  Dynamic  Programniln 


The  corridor  cost  Is  due  to  the  combined  effect  of  risk,  short  length 
penalty,  and  target  deviation  penalty.  The  expression  for  the  cost  Is  as 


below: 


Cl.J-  [(R1./  +  Di,jP)/3]l/P 


where  the  subscripts  represent  the  Index  of  different  levels  of  corridors  and 

serve  to  distinguish  the  primary  and  secondary  corridors. 

After  each  corridor  has  been  assigned  a  cost,  dynamic  programming  Is 

applied  to  determine  the  optimal  path  which  minimizes  the  combined  cost  of  two 

levels  as  expressed  by  the  following  formula 

Coptlraal  *  Minimize  {Cj  n  +  Minimize [Ci<] }  (24) 

1  j 

For  a  mathematical  wavy  terrain  with  obstacles  superimposed,  a  computer 
simulation  Is  performed  to  evaluate  this  path  selection  scheme. 


CONCLUSIONS 

A  set  of  the  measurement  data  Is  obtained  by  the  described  scanning 
scheme.  Rapid  estimation  scheme  detects  the  possible  edges  of  the  obstacles 
by  processing  the  range  measurement  data.  The  points  detected  by  this  R.E.S. 
are  Identified  either  as  a  boulder,  crater,  ridge,  or  false  detections.  The 


length  of  the  corridors  that  a  rover  can  travel  is  determined  from  the 
locations  and  sizes  of  the  obstacles  Identified.  Moreover,  the  range 
measurement  data  are  processed  by  gradient  estimation  scheme  to  evaluate 
Inrpath  and  cross-path  slopes  at  the  data  points.  Since  the  slopes  are 
estimated  In  the  spherical  coordinate  system.  It  Is  needed  to  transform  the 
range  slope  In  spherical  coordinate  system  to  terrain  slope  in  cylindrical 
coordinate. 

The  In-path  and  cross-path  slopes  and  their  covariances  at  the  spine  and 
track  points  along  the  corridors  are  evaluated  by  applying  two-dimensional 
Interpolation  scheme  over  the  estimated  slopes  at  the  data  points.  The 
terrain  variables  at  a  discrete  section  along  each  corridor  are  computed  by 
using  estimated  slopes  at  the  spine  and  track  points.  Since  the  terrain 
variable  estimates  have  uncertainty,  the  present  method  increases  the 
reliability  by  considering  standard  deviation  as  well  as  their  mean  values. 

The  path  selection  scheme  evaluates  risk  Index  for  each  corridor  by 
applying  the  modified  vector  space  algorithm  to  the  terrain  variables.  It  Is 
concluded  that  certain  similarity  exists  between  the  autonomous  navigation  of 
the  mobile  robot  vehicle  and  the  Mars  rover.  The  latter  work  can  serve  as  a 
starting  point  for  future  research  on  navigation  of  mobile  robot  vehicle. 
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Figure  2.  Flow  diagram  of  the  data  acquisition  and  decision  making  system. 
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Figure  8.  A  slope  map  in  the  x-y  plane  for  the  In-path  terrain 
slopes  obtained  from  a  two-dimensional  smoothing 
algorithm. 
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